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Dynamics  Model  for  a  Multi-Tethered  Space-Based  Interferometer 


Introduction 

This  report  presents  the  derivation  of  the  equations  of  motion  for 
a  simplified  model  of  a  novel  space-based  interferometer'11.  The 
instrument,  intended  for  operation  at  the  L2  Lagrange  point,  would  be 
comprised  of  multiple  collector  elements  carried  by  individual 
spacecraft  whose  motion  would  be  precisely  coordinated.  The  concept 
entails  a  symmetrical  radial  arrangement  of  the  respective  spacecraft 
connected  to  a  common  central  vehicle  by  low  mass  tethers.  During 
observations  the  system  as  a  whole  would  rotate  in  a  common  plane  while 
the  collector  elements  simultaneously  moved  radially  to  scan  the 
subtended  circular  area.  Figure-1  illustrates  one  candidate 
configuration. 

This  report  establishes  a  basic  mathematical  model  of  the 
conceptual  system,  develops  the  unabridged  equations  of  motion, 
discusses  tether  constitutive  behavior,  and  includes  treatment  of 
prescribed  motion  of  designated  degrees  of  freedom. 

The  mechanical  system  considered  in  this  report  is  comprised 
of  a  single  rigid  body  and  N  point  masses.  The  point  masses  are  taken  to 
be  connected  to  the  rigid  body  at  distinct  points  by  idealized  tethers. 
The  tethers  are  treated  as  massless  tensile  members  of  variable  length, 
capable  of  exerting  force  only  along  the  straight-line  connecting  the 
respective  endmasses  with  the  rigid  body  attachment  points.  The  tethers 
do  not  support  compression  nor  any  components  of  shear  force  or  bending 
moment.  The  formulation  is  sufficiently  general  to  allow  consideration 
of  both  extensible  and  inextensible  tether  models. 

For  the  development  of  the  equations  of  motion  the  degrees  of 
freedom  of  the  system  are  left  unrestricted,  i.e.  there  are  no  small 
magnitude  limitations.  The  rigid  body  can  translate  and  rotate  in  three 
dimensions  and  the  tethered  endmasses  are  each  provided  three 
translational  degrees  of  freedom.  The  system  components  are  all  subject 
to  external  forces  while  the  rigid  body  is  subject  to  external  torque  as 
well.  The  motion  equations  are  derived  from  fundamental  Newton-Euler 
momentum  principles.  The  development  of  explicit  expressions  for 
gravitational  and  other  environmental  forces  are  not  included  here.  To 
allow  for  the  determination  of  forces  and  torques  necessary  to 
accomplish  specified  motions  in  any  or  all  the  degrees  of  freedom, 
kinematic  constraints  are  imposed  on  the  system.  The  altered  form  of  the 
dynamics  equations  and  the  expressions  for  the  constraint  forces  are 
developed.  The  equations  governing  the  motion  of  both  the  constrained 
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and  unconstrained  systems  are  brought  to  complete  closed  sets  suitable 
for  numerical  implementation. 

Idealization  of  the  tethers  as  massless  affords  the  model 
substantial  analytical  simplicity  and  numerical  efficiency  but  at  the 
cost  of  limiting  the  dynamic  fidelity.  Without  distributed  mass  there  is 
no  way  to  account  for  transverse  deflections  or  vibrations  of  the  tether 
beyond  fundamental  pendular  motions  (present  under  rotation) .  For  an 
extensible  tether  with  a  linear  elastic  or  linear  viscoelastic 
constitutive  law  the  fundamental  longitudinal  vibration  mode  can  be 
captured  but  all  such  higher  modes  are  forfeited. 


Figure-1.  Concept  Tethered  Interferometer. 


System  Definition 

The  system  consists  of  a  rigid  body  R  and  N  point  masses  P. 

( i  =  1 , 2 ,  . . . , N)  .  Particles  Pi  connect  to  points  Ai ,  fixed  to  R,  by  massless 
tether  members.  The  tethers  are  only  capable  of  applying  tensile  force 
between  their  respective  end  points  Ai  and  P. .  Full  three  dimensional 
motion  is  assumed,  hence  the  system  possesses  6+3N  degrees  of  freedom. 
Reference  point  0  is  fixed  to  R  at  its  mass  center  and  establishes  an 

origin  for  the  R  fixed  reference  frame,  5r  •  Reference  point  I  is  an 
inertially  fixed  point,  and  is  taken  as  the  origin  for  an  inertial 
reference  frame,  denoted  7i  •  The  system  geometry  as  well  as  the 
following  position  vectors  are  shown  in  Figure-2. 

R0  -  position  vector  from  point-I  to  point-0. 

-  position  vector  from  point-0  to  point-A^ 
pL  -  position  vector  from  point-Ai  to  P. . 
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?  -  position  vector  from  point-0  to  a  material  point  of  R. 

The  system,  (R  +  P,  +  P2  +  ...  +  PN)  ,  is  subject  to  the  external  forces 
and  torques  defined  below. 

Fi  -  resultant  external  force  acting  on  P. . 

Fr  -  resultant  external  force  acting  on  R. 

Gr  -  resultant  moment  about  point-0  of  external  forces  acting  on 
R. 


Figure-2.  System  Vector  Geometry. 


Let  mR  denote  the  mass  of  R,  and  be  the  mass  of  P. .  The  total 
mass  of  the  system  is 


N 

=  mR  +  £  m, 

i  =  l 

The  position  of  the  system  mass  center  with  respect  to  point-0  is  given 
by 


System  Momenta 


2  niifei+Pi) 


i  =  l 


(1) 


Throughout  the  following  development  the  notation;  v  designates 
the  time  derivative  of  vector  quantity  v  with  respect  to  the  inertial 

o 

frame  5^  .  Similarly,  the  notation  v  denotes  time  differentiation  of 
the  vector  with  respect  to  the  R-fixed  frame,  "PK  .  The  angular  velocity 
of  with  respect  to  is  00. 
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The  linear  momentum  of  Pj  is 


lji  =  mi(  R0  +  a£  +  Pi ) 

Let  the  absolute  velocity  of  point-0  be  denoted  v0  ,  then 


L.  =  m- 


V0  -  (  Si+pJ 


x  w  +  Pi 


(2) 


The  total  linear  momentum  of  the  system  is 


L  =  mRv0  +  Yj  Li 

i  =  l 


or 


L  =  mtv0  -  mcfc  x  S  +  £ 

i=l 


(3) 


The  absolute  angular  momentum121  of  the  system  about  point-0  is 

f  N  o 

H0  =  J  r  x  (  v0  +  55  X  r  )  dm  +  ^  rtii  (ai  +pt )  X  (  v0  +  S  x  (a£  +pi )  +  p.  ) 

R  i=l 


Expanding,  simplifying,  and  collecting  terms  yields 


«  «  0 

H0  =  (  IR  +  X  )  •  «  +  x  v0  +  £  mi (ai+Pi )  x  Pi  (4) 


i  =  l 


i=l 


where  the  following  inertia  dyadics  have  been  introduced: 

IR  -  inertia  dyadic  of  R  with  respect  to  point-0. 

J\  -  inertia  dyadic  of  Pi  with  respect  to  point-0. 

Ji  =  mi  [  (ai+Pi)-  (a.+Pi)  1  -  (ai+Pi)  (ai+Pi)]  (5) 


where  1  is  the  unit  dyadic.  Also  of  interest  is  the  absolute  angular 
momentum  of  the  system  about  the  system  centroid 

-  n 

Hc  =  J  (r  —  rc)  X  (  v0  +  S  x  ?  )  dm  +  £  X  (v0  +  +  px) 

R  i=l 


or 
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H 


c 


+  Z  Ji 


W  +  X  mi(ai+Pi~rc)  X  Pi 

i=l 


(6) 


Dynamic  Equilibrium  Equations 

Let  T£  be  the  force  on  Pi  from  the  tether  connecting  it  to  R. 
Newton's  second  law  for  Pi  requires 


L,  =  R  +  T, 


(7) 


Considering  the  system  as  a  whole,  Newton’s  second  law  requires 


N 

L  =  FR  +  X  Fi  (8) 

i=l 

The  law  of  moment  of  momentum121  supplies  an  additional  vector 
equilibrium  equation.  When  written  with  respect  to  point-0,  that  law 
requires  that  the  system  satisfy 


A  _  N 

H0  +  v0  x  L  =  Gr  +  ]T  m^ai+pj  x  F,  (9) 

i  =1 

Equations  (7) -(9)  constitute  2+n  independent  vector-dyadic  dynamic 
equilibrium  equations  for  the  system. 

Scalar  Equations 

It  is  presumed  that  each  tether  has  a  preferred  nominal  direction 
relative  to  R.  A  reference  frame  7.  fixed  to  R,  with  origin  at  Ait  is 
established  for  each  tether  with  its  x-axis  in  the  desired  tether 
reference  direction.  The  other  two  axes  of  7i°  are  oriented  for 

convenience.  The  orientation  of  7°  with  respect  to  7R  is  defined  in 

terms  of  a  constant  direction  cosine  matrix,  [  CRi ] ,  which  transforms 
the  respective  unit  basis  vectors  according  to 


\ 

1R 

A 

3r 

=  [c°RJ 

"50 

Di 

✓V 

A 

kR 

R  ) 

k° 

l  1  / 

It  proves  convenient  to  define  another  reference  frame  7i  ,  which 
moves  such  that  its  x-axis  is  always  in  the  direction  of  the  line 
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segment  from  Ai  to  P. .  The  orientation  of  with  respect  to  is 
described  in  terms  of  a  sequence  of  two  single  axis  rotations.  Let 
be  an  intermediate  reference  frame  which  is  achieved  from  7i°  by 
rotating  an  angle  0i  about  the  ki  axis  (positive  according  to  the  RHR) 

*?i  is  achieved  from  *Pi  by  a  rotation  of  angle  cpi  about  the  axis 

(positive  according  the  RHR) .  Concatenating  the  respective 
transformations  yields 


T 

ccp  C0 

C(p  s@ 

-scp 

(l0  ^ 

j 

— 

-s  0 

C0 

0 

^0 

3 

k 

J 

i 

S(p  C0 

scp  S0 

ccp 

i 

k° 

k  h 

or  in  terms  of  the  notation  of  Hughes131 

?i  =tci0]  ?i 

Above  we  have  introduced  the  short-hand  notation:  cep  =  coscp  , 

S(p  =  sincp,  and  similarly  for  0.  The  transformation  from  5^  to  is 

expressed  as 

?n=[CR,]?1 

where 

tCRi]  =  [C°i][Ci0]T 


Let  Cx( t)  be  the  straight-line  distance  between  points  Aj  and  P. . 

Then 

Pi  =  ^i(t)  ii 

The  geometry  is  illustrated  in  Figure-3. 


Figure-3.  Tether  Reference  Frame  Geometry. 
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Resolved  into  components  referred  to  frame  £r  ,  we  write 


Pi  =  P; 


with 


P;  =  [CRJ  I  ^C(P  SQ 


l  ccp  c9 


-6  scp 


A 


The  time  derivative  of  with  respect  to  frame  5r  is  expressed  as 

Pi  =  ?r  P, 


where 


P,  =  tC°Ri]pJq. 


and  where  we  have  introduced 


CL  = 


and 


'O 

e, 


[DJ  = 


ccp  c0  -i ccp  s0  -^scp  c9 
ccp  s@  £ccp  c@  -^scp  s© 
—scp  0  —Cc(p 


The  time  derivative  of  [DJ  is  recorded  as 


-(cp  scp  cG  +0  ccp  sg) 

-iccp  sG  +  ^(cp  scp  sG  -  G  ccp  cg) 

- (scp  cG  +  ^(q  s<p  sG  -  cp  ccp  cG  ) 

[DJ  = 

(g  ccp  cG  -  cp  scp  sq) 

^ccp  cG  -  ^(<p  scp  cG  +  0  ccp  sg) 

-^scp  sG  -  ^(<p  ccp  sG  +  0  scp  cg) 

-cp  ccp 

0 

-iccp  +  ^<p  scp 

The  vector  quantities;  aL  ,  r c  ,  GO,  v0  ,  FR  ,  GR  ,  ,  L  ,  H0 ,  Hc 

are  expressed  in  scalar  components  resolved  in  “PK  as  the  3x1  column 
matrices;  aL  ,  rc  ,  CO,  v0  ,  FR  ,  G„  ,  hL ,  L,  H0  ,  Hc  .  Similarly,  the 
dyadics;  IR  and  are  expressed  in  scalar  form  resolved  in  "PR  as  the 
3x3  matrices;  [IR]  ,  [JJ  .  The  force  vectors;  F±  and  Tl  are  resolved 
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into  components  referred  to  ,  and  expressed  as  the  3x1  column 
matrices  FL  and  Tt  . 

Resolved  into  components  referred  to  ,  Eq.  (2)  can  be  written  as 

Li  =  Vo  -  m^ai+p.^M  +  [EJ  q. 

where  we  have  introduced 

[EJ  =  mJC°Ri]  [DJ 

and  the  skew  symmetric  matrix  cross  product  operator  notation: 


0 

-t>3 

b2  ' 

b  = 

b2 

=>  bx  = 

b3 

0 

“bi 

-b2 

bi 

0  _ 

Equation  (7)  resolved  in  is  written  as 

™i±o  -  iMSi+Pj.  )*u  +  [EJ  q.  =  [CRi  ]  (  +  T£ )  +  £J±  (10) 


where 


and 


Ni  =  -Q  (Li  +  [Ei  ]  q. )  -  [E,  ]  q. 

[EJ  =  m,  [CRi  ]  [Di  ] 

The  system  linear  momentum,  Eg. (3)  resolved  in  “?R  ,  is  written  as 

N 

L  =  mtv0  -  mtrcx(o  +  £  [EJ  q. 


(11) 


i  =  l 


The  position  of  the  system  centroid  with  respect  to  point-0  is 

1  N 

rc  =  - y  mjai  +  p  ) 

mt  i=i 

In  scalar  form  Eq. (8)  is  expressed  as 

N  N 

hto  -  mtrcxw  +  X  [EJq.  =  FR  +  £  [CR  J  F,  +  NL 


nu 


(12) 


1  =  1 


i  =1 


where 


Nl  =  -U*  (  L  +  X  [Ei]  q,  )  -  X  [Ei]  Si 


i=l 
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The  centroidal  angular  momentum  of  the  system,  from  Eq.  (6)  becomes 


{n  In 

Hr]  +  X  _  mt(  £c£c[l]  -  rcre  )|  “  +  X  +  £c)x  [EJ  q.  (13) 

where  [1]  is  the  3x3  identity  matrix.  The  scalar  form  of  Eq. (5) ,  and 
its  time  derivative,  are  recorded  as 

[JJ  =  raj  (ai  +  p.  )T(ai  +  p. )  [  1  ]  -  (ai  +  p. )  (a3  +  p.  )T] 

[jj  =  mj  2(ai  +  p.)Tp.[l]  -  (ai  +  p. )  p*  -  p£  (ai  +  p.)TJ 

The  system  rotational  equilibrium  equation  given  by  Eq. (9)  is 
written  as 


mtrcxv0  + 


[IR]  +  XtJj  «  +  Xtei  +  p.ftEjq. 


i=l 


(14) 


IN 

=  Gr  +  ^  (ai  +  Pi)x[CRi]  Fi  +  N„ 


i=l 


where 


N. 


mtrcxVo 


X 

CO 

(  N  > 

[Ir]  +  X[Ji] 

N 

w  +  X(^  +  Ei)X[Ei]5i 

A  i=1  ) 

i  =  l 

N 

-  £(ai  +  p.)x[Ei]qi 

i=l 


Equations  (10),  (12),  and  (14)  constitute  6+3N  independent  scalar 

equilibrium  equations  for  the  system.  The  system  motion  equations 
assembled  in  matrix  form,  in  the  order;  (12),  (14),  and  (10), 

(i=l ,  2  ,  .  .  .  ,N)  ,  (with  the  last  premultiplied  by  [Di  ]T  [C^  ]T  )  ,  are 


Xi 

m12 

m13' 

Yo 

_Nl" 

El’ 

"o 

m21 

m22 

m23 

G) 

= 

Nh 

+ 

Eh 

0 

_m31 

m32 

M33. 

_q_ 

_Nq. 

_Eq_ 

T 

q  _ 

(15) 


The  premultiplication  of  Eq.  (10)  by  [Di]T[C^i]T  was  necessary  to  achieve 

a  symmetric  generalized  mass  matrix.  The  notation  introduced  in  Eq.  (15) 
is  defined  below. 
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V 

'[DiftctfNi' 

q  = 

— q  = 

[D2]t[C°2]tN2 

2n 

;dn]t[cLitnn_ 

PiftCoJFi' 

PJT[C 01]  Ti" 

F  = 

— q 

[D2]t[C02]F2 

Tq  = 

[d2]t[c02]  t2 

_[dn]t[con]  fn_ 

,[Dn]t[Con]  tn_ 

N 

EL  =  FR  +  X^rJIV 

i  =1 
N 

F„  =  GR  +  Xtei+P/K^JF, 

i  -1 

The  partitions  of  the  generalized  mass  matrix  are: 


Mn  =  mt[  1  ] 

=  -mtr* 

Mis  =  Mjj  =  [[EJ  [E2]  •••  [Ej] 


where 


m22  =  [IR]  +  X  [Ji] 

i=l 


M23  =  m3‘2 


=  [(sh  +  p/tEj  j  (a2  +  p2)*[E2]  j  ...  j  (a„  +  p  )X[E„ 


M 


33 


[0]  m2[D2]T[D 


mjDJ^Dj  [0]  •••  [0] 

[0] 

[0]  mN[DN]T[DN] 


[0] 


mi  0  0 

0  mi^i2c2(pi  0 

0  0  m^2 
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The  generalized  mass  matrix  is  positive  definite,  provided  consideration 
is  restricted  to  ^(t)  >  0  and  (pL  *  ±  Tc/2  ( i =1 ,  2 ,  .  .  . ,  N)  . 

Tether  Tension 

The  tether  force  acting  on  P.  is  .  When  in  a  tensile  state, 
is  directed  from  PL  to  At.  From  the  definition  of  frame  5^  we  have 


where  T-_ 
[Di ]  and 


Ti  -  -T. 


'i ' 
0 
0 


=  -Ti  Si 


V  J 

is  the  magnitude  of  the  tether  tension.  From  the  definitions  of 
[Coi]  ,  the  generalized  tension  force  term  in  Eq. (15)  simplifies 


to 


TIT  T  T  l 

Tq  =  (-Tiei  -T2ei  •••  — TNex  )  (16) 

Extensible  Tether 

To  accommodate  an  extensible  tether  model  a  constitutive  law  is 
required.  Two  such  elementary  relations  are  considered  here.  The 
subscript  identifier  i  is  dropped  here  for  clarity.  Let  60{t)  denote  the 

unstrained  length  of  tether  deployed  at  time  t.  The  longitudinal  strain 
of  the  tether,  for  our  idealization,  is  defined  as 

e  =  *(t)  -  *o(t) 

^o(t) 

The  longitudinal  stress  in  the  tether  is  simply 

T 

O  =  — 

A 

where  A  is  the  cross-sectional  area  of  the  load  carrying  material.  For  a 
linear  elastic  material  the  stress-strain  relation  is 

G  =  E£ 

where  E  is  the  modulus  of  elasticity.  Combining  the  above,  an  expression 
for  the  tension  of  a  linear  elastic  tether  material  is  obtained 

EA 

T  =  - (  i( t)  -  *0(t)  )  ;  l  >  l 0  (17) 

W 
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By  admitting  more  general  forms  of  the  stress-strain  relation  more 
complicated  material  behaviors  can  be  considered.  Simple  energy 
dissipation  can  be  introduced  by  adding  a  stretch  rate  dependent  term, 

T  =  —  <4t)-/0(t))  +  C(  *-*„);  i  >  i0  (18) 

*o(fc) 

where  C  is  a  damping  coefficient  to  be  specified.  Since  the  tether  can 
not  resist  compression  the  tension  force  is  taken  to  be  identically  zero 

for  l  <  .  Equations  (17)  or  (18)  are  sufficient  to  specify  the 

tension,  provided  £0(t)  is  known,  as  for  example  would  be  the  case  with 
a  motorized  deployer. 

Inextensible  Tether 

For  an  inextensible  tether  there  is  no  constitutive  law.  One  can 
still  proceed  provided  that  either  the  tension  is  known  in  terms  of  a 
definite  function  of  the  system  state  variables  and/or  time,  or  if 
kinematic  constraints  can  be  specified.  The  former  case  can  occur  during 
deployments  or  retractions  under  the  action  of  a  mechanized  controller, 
or  during  deployments  in  the  presence  of  known  frictional  forces. 
Kinematic  constraints  arise  when  a  tether  is  presumed  to  be  taught  and 
its  length  time  history  is  known,  a  situation  which  is  treated  in  the 
final  section  of  this  report. 

Kinematics  of  R 

The  orientation  of  the  body  fixed  frame  with  respect  to  the 
inertial  frame  is  described  in  terms  of  a  1-2-3  Euler  angle 

A  A  A 

sequence.  The  orthogonal  unit  basis  vectors  i,  j,  k  for  each  frame 

referred  to  below  are  denoted  with  appropriate  subscript  and  superscript 
identifiers.  The  signs  of  all  single  axis  rotations  are  positive 

according  to  the  right  hand  rule.  Let  5?  be  an  intermediate  frame 
achieved  from  5?  by  a  rotation  of  angle  iJj1  about  the  xz  axis.  Let  frame 
5r  be  achieved  from  by  rotation  of  angle  iJj2  about  the  axis  jz  . 
is  achieved  from  by  a  rotation  of  angle  l|/3  about  the  kR  axis.  The 

direction  cosine  matrix  transforming  vector  components  from  to  is 

obtained  by  concatenating  the  sequence  of  rotation  transformations  and 
is  denoted  as: 
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[Cir]  - 


c4r2djj3  — c\|r2sTjr3  sxJ/2 

ci|r1sT|r3  +  siJj1silf2ciJ;3  cil/1cijx3  -  si^ — s^/1ciJj2 
sijf1s\lf3  -  ciir1sijf2cij;3  si|;1ci|;3  +  ci^si^s^  ci|j1ci|r2 

where  we  have  again  used  the  short-hand  notation:  c\|f=  costy  ,  sx|r  = 
sini);  . 

The  angular  velocity  of  ?R  with  respect  to  7X  is 


“  =  Ml  +  t2  X  +  kR 

Resolved  into  components  referred  to  we  have 


ci|/2ciJj3  s4r3  0 

CO  = 

— cxJ/2stJ/3  cijj3  0 

siJ/2  0  1 

>3. 

=  in]  4r 

Inverting  the  above  equation  yields 


'V 

-  S^3/C4f2  0 

i2 

= 

s4f3  cijf3  0 

“2 

>3. 

-  oxJ/3 ti|i2  s\J/3ti|/2  1 

_«3_ 

or  more  compactly, 

4r  =  [n  ]_1  CO 


(19) 


(20) 


where  tl|/2  =  tan  i|f2  ,  and  the  singularity  at  l|/2  =  ±  7t/2  is  noted. 

Recall  that  the  position  of  point-0  with  respect  to  point-I  was 
given  by  R0  .  The  time  derivative  of  R0  observed  in  is  v0  .  The 

components  of  v0  resolved  in  “?R  are  v0  .  If  we  let  R0  be  the  3x1  column 
matrix  of  components  of  R0  referred  to  then 


Ro  =  [CIR]  v0 


(21) 


System  State  Vector 

The  instantaneous  configuration  of  the  system  is  given  by  the 
vector  of  generalized  coordinates: 
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xT  =  (B;  f  a  si  -  si ) 


The  motion  equations  for  the  system,  Eq. (15) #  have  been  written  in  terms 
of  the  vector  of  velocities 


vT  =  ( 

The  mechanical  state  of  the 
vector 


T  T  .  T  .  T 

Vo  a  qx  q2 
system  is  thus 


specified  entirely  by  the 


M=ff} 

and  its  time  derivative,  given  by 


[  [M]  1  (  N  +  F  +  T  ) 


[Cir  ]  Yo 

[nr1  co 

2i 


q 


where  the  upper  partition  of  the  RHS  corresponds  to  Eq. (15) . 


(23) 


Prescribed  Motion 

In  the  development  of  control  systems  for  complicated  mechanical 
systems  it  is  often  helpful  to  be  able  to  determine  the  forces  and 
torques  which  must  act  to  produce  the  desired  motions.  In  this  section 
the  foregoing  formulation  is  modified  to  allow  for  the  specification  of 
any  or  all  the  degrees  of  freedom.  A  specified  or  prescribed  degree  of 
freedom  is  assumed  to  have  a  known  time  history,  i.e.  the  coordinate  and 
its  time  derivatives  are  known  a  priori. 

The  dynamic  equilibrium  equations,  Eq.(15),  are  here  recast  in 
terms  of  the  time  derivatives  of  the  coordinates  of  X  rather  than  those 

of  V.  Equations  (20)  and  (21)  provide  the  transformations  between  the 
nonholonomic  velocities  v0  and  G)  and  the  time  derivatives  of  the 
position  and  attitude  coordinates  R0  and  I ]f  .  Thus 
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V  =  [B]  X 


where 


[CRI] 

[0] 

to] 

[0] 

in] 

[0] 

[0] 

[0] 

[1] 

It  follows  that 

V  =  [  B  ]  X  +  Nx 


(24) 


where 


Nx 


[C8i]Ro 

[ftii 

0 


[CRI]  =  -co*  [CRI] 


— ( xir2sT]r2ciJ/3  +  i3c\l;2s4r3 )  j 

iir3c4f3 

i  o 

[ii  ]  = 

iir2s4r2s^3  -  i[r3ci|f2ci|r3  j 

-^3s^3 

o 

4r2c4f2  : 

0 

j  0 

Substituting  Eq. (24)  into  Eq. (15) ,  we  write 


[M]  [B]  X  =  (  N  -  [M]  Nx  )  +  F  +  T 


(25) 


The  coefficient  matrix  of  the  accelerations  can  be  made  symmetric  by 
premultiplication  of  Eq. (25)  by  [B]T, 

[Bf  [M]  [B]  X  =  [Bf  (  N  -  [M]  Nx)  +  [B]t  F  +  T 
or 

[M  ]  X  ==  N*  +  F  +  T  (26) 

where  the  primes  denote  the  transformed  quantities,  and  it  is  noted  that 
[B]tT  =  T  . 

For  prescribed  motion  in  any  n  of  the  coordinates  contained  in  X 
the  constraint  equations  assume  the  particularly  simple  form 

[Spfx  =  xp(t)  (27) 
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where  [Sp]  is  a  simple  constant  boolean  selection  matrix  of  dimension 

(6+3N)xn,  and  xp(t)  are  n  specified  functions  of  time.  The  time 
derivative  of  Eq. (27)  is 


[Spf  X  =  Xp(t)  (28) 

The  equations  of  motion  given  by  Eq. (26)  correspond  to  the 
unconstrained  system.  If  certain  of  the  degrees  of  freedom  are  to  be 
specified  it  is  evident  that  some  set  of  constraint  forces  must  act  to 
enforce  the  designated  motion.  For  the  constraints  given  by  Eq. (28)  it 
is  known  from  analytical  mechanics141  that  the  right  hand  side  of  Eq.  (26) 

must  be  augmented  by  generalized  constraint  forces  of  the  form  [Sp]A, 

where  A  is  an  nxl  column  matrix  of  Lagrange  multipliers.  The  augmented 

form  of  the  motion  equations  subject  to  the  aforementioned  constraints 
are 


[  M*  ]  X  =  N  +  F*  +  T  +  [Sp]  A  (29) 

Differentiating  Eq. (28)  with  respect  to  time  then  allows  the  constraints 
and  motion  equations  to  be  written  together  as 


[M']  4SP]" 

m 

V  4-  F  +  T> 

as  pf  oT 

One  of  a  number  of  solution  procedures  is  to  solve  Eq.(30) 
simultaneously  for  X  and  A,  then  numerically  integrate  the  system 
state  equations. 

Physical  Forces  of  Constraint 

To  determine  the  scalar  components  of  the  physical  constraint 
forces  and  torques  required  to  enforce  the  prescribed  motion  the 
correspondence  between  those  elements  and  the  generalized  forces  of 

constraint ,  given  by  [Sp]A,  must  be  established.  Referring  to  Eq. (15) # 
and  the  immediately  following  definitions,  the  vector  of  generalized 
forces  F  can  be  written  in  terms  of  the  resultants  of  the  external 
applied  forces  and  torques  acting  on  the  system  components  as 
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or 


[1] 

[0]  1  [CR1] 

[C«] 

[0] 

[1]  itei+p/tCaJ 

(a2+P2)x[CR2]  — 

F  = 

F„ 

Z= 

[0] 

[0]  j  [D2  ]T[C01  ] 

[0] 

.Eq. 

[0] 

[0]  j  [0] 

[D2]t[C02]  - 

F  =  [  A  ]  Fa 


From  Eq.  (29)  we  observe  that  the  external  applied  forces  Fa  are  related 
to  the  corresponding  generalized  forces  by 


£  =  [Bf  [  A  ]  Fa 

Any  constraint  forces  which  act  in  addition  to  the  external  applied 
forces  must  "connect"  to  the  acceleration  variables  in  Eq.(29)  in  a 
manner  analogous  to  that  of  Fa  .  Let  Fc  be  the  constraint  forces 

enforcing  the  prescribed  motion  which  act  in  parallel  with  those  of  Fa  . 

Then  the  components  of  the  physical  constraint  forces  are  determined 
from  the  Lagrange  multipliers  by 

Fc  =  ([Bf  [Air1  [Sp]X  (31) 
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